APPARATUS AND METHOD OF COMPENSATING FOR AN ATTITUDE 
ERROR OF AN EARTH MAGNETIC SENSOR 

BACKGROUND OF THE INVENTION 

1 , Field of the Invention 

[0001] The present invention relates to a measurement apparatus and 

calculation method that is able to calculate accurate azimuth information by 
compensating for an attitude error of an earth magnetic sensor using 
information on an earth magnetic field obtained from a two-axis earth magnetic 
sensor and an inclinometer. 

2. Description of the Related Art 

[0002] Up to now, significant research has been performed to identify a method 

and apparatus for calculating azimuth information of a vehicle or a sensor 
module, which moves in free space, using an earth magnetic sensor, such as a 
fluxgate. However, since the fluxgate is expensive and large in size, it has 
been used only for navigation. 

[0003] Recently, smaller and lower cost earth magnetic sensor modules have 

been developed. Due in part to developments in micro-electromechanical 
systems (MEMS) technology, chip-type earth magnetic sensor modules have 
been developed and used in diverse fields that require the azimuth information. 



In application fields where the earth magnetic sensor module cannot be leveled, 
however, accurate azimuth information cannot be obtained through only the 
earth magnetic sensor. 

[0004] Generally, an earth magnetic sensor is a device for measuring the 

strength of the earth magnetic field. An earth magnetic sensor can measure 
the strength of the accurate magnetic field only in a case that a flux vector of the 
earth magnetic field is parallel to a vector of a measurement axis of the sensor 
for measuring the flux vector. In this case, after a two-axis magnetic sensor, in 
which each axis is orthogonally arranged in accordance with a right-hand rule, 
is horizontally mounted to form a sensor module, the azimuth angle indicated by 
the sensor module is calculated using outputs of the two-axis sensor. 

[0005] If the earth magnetic sensor module cannot be leveled, however, the 

strength of the earth magnetic field cannot accurately be measured, and the 
azimuth information may include a significant error. Consequently, an error 
according to an attitude should be compensated for, and to provide this 
compensation, an error compensation through a coordinate conversion is 
performed using a three-axis earth magnetic sensor and an inclinometer for 
measuring the attitude. 



[0006] With the development of a small-sized earth magnetic sensor, the 

attitude error compensation technique is able to expand into application fields 
such as sports, multimedia, game machine, and the like. 

[0007] In the case of using the two-axis earth magnetic sensor, due to the 

problems of a sensor installation space, however, the error cannot be 
compensated for through only the developed error compensation technique. 
Thus, the azimuth angle calculated increases the error according to the size of 
the attitude. 

SUMMARY OF THE INVENTION 
[0008] A feature of an embodiment of the present invention is to solve at least 

the above-identified problems and/or disadvantages and to provide at least the 
advantages described hereinafter. 
[0009] Another feature of an embodiment of the present invention is to provide 

an apparatus and method of calculating accurate azimuth information by 
compensating for an attitude error of a two-axis earth magnetic sensor. In the 
case that the two-axis earth magnetic sensor is mounted on a device that 
requires the azimuth information (for example, a navigation system, game 
machine, PDA, cellular phone, or the like), the apparatus and method according 
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to the present invention calculates the attitude infonnation using a two-axis 
inclinometer, and then compensates for the error according to the attitude of the 
earth magnetic sensor to obtain the accurate azimuth information. 

[0010] To provide the above features of the present invention, there is provided 

an apparatus for calculating an azimuth angle, including a two-axis earth 
magnetic sensor, which is mounted on a device that requires azimuth 
information, for measuring a strength of an earth magnetic field according to the 
azimuth information if the device moves, an inclinometer for calculating an 
attitude such as a roll angle and a pitch angle, a signal conditioning unit 
including an analog-to-digital (A/D) converter for converting sensor data into a 
digital value, a microprocessor for calculating the azimuth angle by 
compensating for an attitude error using outputs of the two-axis earth magnetic 
sensor and the inclinometer, a serial communication interface for transmitting 
the data processed by the microprocessor, and an LCD module for displaying 
the azimuth information calculated by the microprocessor, 

[001 1] In another aspect of the present invention, there is provided a method of 

calculating an azimuth angle, including setting a data output period using an 
internal timer mounted on a microprocessor, converting an analog value sensed 



by a sensor into a digital value using an analog-to-digital converter, storing the 
converted sensor data in an internal register of the microprocessor, calculating 
an attitude and obtaining a coordinate conversion matrix using data obtained 
from an inclinometer, generating a virtual Z-axis earth magnetic data using a 
two-axis earth magnetic sensor, calculating earth magnetic data on a horizontal 
coordinate system using three-axis earth magnetic data, wherein the three-axis 
earth magnetic data includes a combination of the two-axis earth magnetic 
sensor data and the one-axis virtual sensor data, and a coordinate conversion 
matrix, calculating the azimuth angle using the calculated earth magnetic data, 
and if a timer interrupt is generated due to the output period set in the internal 
timer, transmitting the sensor data and the calculated azimuth angle to an 
external system through a serial communication interface and displaying the 
sensor data and the calculated azimuth angle on an LCD module. 

Generating the virtual Z-axis earth magnetic data preferably includes 
measuring by experiment a strength of an earth magnetic field measured when 
a measurement axis of the earth magnetic sensor points in a vertically 
downward direction toward the earth, calculating the attitude using an output of 
the inclinometer, measuring a strength of the earth magnetic field sensed in an 



X-axis direction and a Y-axis direction of a sensor module using the two-axis 
earth magnetic sensor, and generating the virtual Z-axis earth magnetic data 
using the calculated attitude of the sensor module and an output value of the 
two-axis earth magnetic sensor. 

[0013] Calculating the earth magnetic data on the horizontal coordinate system 

preferably includes calculating the coordinate conversion matrix using the 
attitude calculated using an output of the inclinometer, and calculating the earth 
magnetic data of the horizontal coordinate system by multiplying the generated 
Z-axis earth magnetic data and the measured X-axis and Y-axis earth magnetic 
data by the calculated coordinate conversion matrix. 

[0014] Calculating the azimuth angle using the two-axis earth magnetic sensor 

preferably includes calculating the attitude using the inclinometer and obtaining 
the coordinate conversion matrix, generating the virtual Z-axis earth magnetic 
data, generating the earth magnetic data on the horizontal coordinate system, 
and calculating the azimuth angle using X-axis and Y-axis data of the earth 
magnetic data on the horizontal coordinate system. 



BRIEF DESCRIPTION OF THE DRAWINGS 
[0015] The above and other features and advantages of the present invention 

will become more apparent to those of ordinary skill in the art by describing in 
detail preferred embodiments thereof with reference to the attached drawings in 
which: 

[0016] FIG. 1 is a box diagram illustrating a method of calculating an azimuth 

angle by compensating for an attitude error by a two-axis earth magnetic sensor 

according to the present invention; 
[0017] FIG. 2 is a box diagram illustrating the construction of a two-axis earth 

magnetic sensor and an attitude error compensation apparatus according to the 

present invention; 

[0018] FIG. 3 is a flowchart illustrating the operation of the microprocessor 

mounted on the two-axis earth magnetic sensor and an attitude error 
compensation apparatus according to the present invention; 

[0019] FIG. 4 is a graph illustrating the experimental result of the attitude 

calculated using the inclinometer according to the present invention; 
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[0020] FIG. 5 is a graph illustrating the experimental result of the virtual Z-axis 

earth magnetic data calculated using the two-axis earth magnetic sensor and 
the inclinometer; and 

[0021] FIG. 6 is a graph illustrating the experimental result of the azimuth angle 

calculated using the two-axis earth magnetic sensor and the inclinometer. 
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

[0022] Korean Patent Application No. 2002-46366. filed on August 6, 2002. and 

entitled: "Apparatus and Method of Compensating for an Attitude Error of an 
Earth Magnetic Sensor," is incorporated by reference herein in its entirety. 

[0023] An apparatus and method of calculating an azimuth angle will now be 

described more fully hereinafter with reference to the accompanying drawings, 
in which preferred embodiments of the invention are shown. The invention 
may, however, be embodied in different forms and should not be construed as 
limited to the embodiments set forth herein. Rather, these embodiments are 
provided so that this disclosure will be thorough and complete, and will fully 
convey the scope of the invention to those skilled in the art. Like reference 
numerals refer to like elements throughout. 
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[0024] FIG. 1 is a box diagram illustrating a method of calculating an azimuth 

angle by compensating for an attitude error using a two-axis earth magnetic 
sensor according to the present invention. The method includes a two-axis 
earth magnetic sensor 101, an inclinometer 102, an attitude (e.g., coordinate) 
conversion matrix part 103, a virtual Z-axis earth magnetic data generation part 
104, a earth magnetic data coordinate conversion part 105, and an azimuth 
angle calculation part 106. 

[0025] The earth magnetic sensor 101 , which may be a fluxgate sensor or a 

magnetoresistive (MR), measures a strength of the earth magnetic field, and 
includes a two-axis earth magnetic sensor having an X-axis in a forward 
direction of the sensor module and a Y-axis in a direction 90** to the right from 
the X-axis. 

[0026] The inclinometer 102 measures a tilt angle of the sensor 101 with 

respect to the surface of the earth. An accelerometer may be used as the 
inclinometer. In a case that an accelerometer that measures only the 
acceleration of gravity at a stationary position, is used as the inclinometer, the 
attitude Information can be calculated by measuring the accelerations of 
different levels according to the attitude using the two-axis or three-axis module 
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arranged at right angles. In a case using a two-axis accelerometer, the 
acceleration is measured through Equations 1a and lb and the attitude is 
calculated using Equations 2a and 2b. 

=g'sm0 (la) 
ay=g'sm^ (1b) 
^ = sin-\ay/g) (2a) 
0 = sm-\ajg) (2b) 
where Bx and Sy are output values of the X-axis and Y-axis accelerometer, 
respectively, g is the acceleration of gravity, and ^ and 0 are a roll angle and a 
pitch angle, respectively. 

The coordinate conversion matrix part 103 converts the earth magnetic 
sensor data into a horizontal coordinate system. The coordinate conversion 
matrix is constructed through Equation 3 using the attitude information 
calculated using the output value of the inclinometer 102. 



cosO sin ^ sin ^ sin ^ cos ^ 

0 cos<^ -sin^ 

- sin 9 cos 0 sin ^ cos 0 cos ^ 



(3) 



-11- 

[0028] The virtual Z-axis earth magnetic data generation part 104 is essential to 

the attitude error compensation of the two-axis earth magnetic sensor. The 
virtual Z-axis earth magnetic data generation is calculated through Equation 4 
using the two outputs of the earth magnetic sensor and the attitude information 
as calculated above. 

Z. + X sinO - Y.^ sint^cos^ 

Zj,-— ^ (4) 

cos ^ cos ^ 



where Zh is a strength of the earth magnetic field first measured by experiment 
when a measurement axis of the earth magnetic sensor points in a vertically 
downward direction toward the earth. 
[0029] The coordinate conversion part 105 of the earth magnetic sensor data to 

the horizontal coordinate system performs Equation 5 as follows. 











- 











Where [Xj^ 



ZjgY '® earth magnetic sensor data. 
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[0030] 



The azimuth angle calculation part 106 peri'orms Equation 6 using the 



earth magnetic data the coordinate of which is converted into the horizontal 



coordinate system. 



(6) 



[0031] 



FIG. 2 is a box diagram illustrating the construction of an interface for a 



two-axis earth magnetic sensor constructed to perform the function as 
described in connection with FIG. 1 . The interface includes a two-axis earth 
magnetic sensor 201 , an inclinometer 202, a signal conditioning unit 203, a 
microprocessor 204, an LCD module 205, and a serial communication interface 
206. 

[0032] The signal conditioning unit 203 includes a low-pass filter for removing a 

power supply noise and a high-frequency noise, and an analog-to-digital (A/D) 
converter for converting the analog sensor signal into a digital value. The 
signal conditioning unit 203 is necessary to process the sensor signal before it 
is inputted to the microprocessor 204. 

[0033] The microprocessor 204 includes a register for storing the sensor signal 

outputted from the A/D converter of the signal conditioning unit 203, an 
Arithmetic Logic Unit (ALU) and an Floating Point Unit (FPU) for compensating 
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for the attitude error of the earth magnetic sensor and calculating the azimuth 
angle, and an internal timer for setting a data output period for transmitting the 
sensor data and the calculated azimuth angle to the LCD module and an 
external device. 

[0034] The LCD module 205 displays the azimuth information, i.e., the azimuth 

angle, outputted from the microprocessor 204 so that a user can recognize the 
azimuth angle of the device having the earth magnetic sensor module mounted 
thereon. 

[0035] The serial communication interface 206 transmits the sensor data and 

the azimuth information outputted from the microprocessor 204 to the external 
device. The serial communication interface 206 may adopt asynchronous 
serial communication or synchronous serial communication type, 

[0036] FIG. 3 is a flowchart illustrating an operation of the microprocessor 

mounted on the two-axis earth magnetic sensor and an attitude error 
compensation apparatus according to an embodiment of the present invention. 

[0037] First, in step 301 , in order to transmit the output values of the two-axis 

earth magnetic sensor 201 and the inclinometer 202 and the finally calculated 
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azimuth information to the extemal system, the data output period is set using 

the internal timer mounted on the microprocessor 204. 
[0038] In order to convert the output values of the earth magnetic sensor 201 

and the inclinometer 202 into digital values, in step 302, an A/D converter 

control signal is generated. Then, in step 303, the converted sensor data is 

stored in the internal register. 
[0039] In step 304, the attitude of the sensor module is calculated through 

Equations 2a and 2b using the inclinometer data from among the stored sensor 

data. Using this calculated attitude, in step 305, the coordinate conversion 

matrix is calculated through Equation 3. 
[0040] In step 306, the virtual Z-axis earth magnetic data is generated through 

Equation 4 using the calculated attitude and the earth magnetic sensor data 

stored in the internal register. 
[0041] In step 307, the three-axis earth magnetic data (i.e., a combination of the 

two-axis earth magnetic sensor data and the one-axis calculated virtual Z-axis 

earth magnetic data) is converted into the strength of the earth magnetic field in 

the horizontal coordinate system through Equation 5 using the calculated 
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coordinate conversion matrix. In step 308, using this converted data, the 
azimuth angle is calculated through Equation 6. 

[0042] In step 309, it is determined whether an interrupt is generated by the 

data output period set in the Internal timer. If it is determined that the timer 
interrupt is not generated, the operation returns to step 302. i.e., converting the 
sensor data into the digital value. Alternatively, if in step 309 it is determined 
that the timer interrupt is generated, in step 310, the azimuth information 
calculated as above and the sensor data are transmitted to the external system 
using the serial communication, and then, in step 311, outputted to the LCD 
module for display. Subsequently, the operation returns to step 302, i.e., 
converting sensor data into a digital value, and repeats the subsequent steps 
until the next timer interrupt is generated. 

[0043] FIG. 4 is a graph illustrating the experimental result of the attitude 

calculated through Equation 2 using the inclinometer 202 according to an 
embodiment of the present invention. 

[0044] FIG, 5 is a graph illustrating the experimental result of the virtual Z-axis 

earth magnetic data calculated through Equation 4 as compared to the real (i.e., 
actual) Z-axis of the three-axis earth magnetic sensor. In FIG. 5, the dashed 
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line represents the real Z-axis of the three-axis earth magnetic sensor, and the 
solid line represents the virtual Z-axis earth magnetic data calculated through 
Equation 4. From FIG. 5, it may be seen that the Z-axis earth magnetic data, 
which varies according to the change of the attitude, is accurately generated 
through Equation 4. 

[0045] FIG. 6 is a graph illustrating the experimental result of the azimuth angle 

calculated through Equations 5 and 6 using the generated virtual Z-axis earth 
magnetic data, the output of the two-axis earth magnetic sensor, and the 
calculated coordinate conversion matrix in the case that the attitude is changed. 
The dashed line represents the uncompensated azimuth angle, which shows a 
great change of the azimuth angle, while the solid line represents the 
compensated azimuth angle, which shows that the azimuth angle is changed 
only within an error range where the change of the azimuth angle is small. 

[0046] According to the apparatus for calculating the azimuth angle by the 

attitude error compensation of the earth magnetic sensor according to the 
present invention, the azimuth information provided to the user overcomes the 
technical limit of the earth magnetic sensor module, which should use the 
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existing three-axis earth magnetic sensor and the inclinometer, using the two- 
axis earth magnetic sensor and the two-axis inclinometer. 

[0047] The present invention can be conveniently used in the case that the 

azimuth information is required. For example, when it is intended to confirm a 
user's heading using an electronic map stored in a PDA, the present accurate 
azimuth angle of the user is recognized and the map is rotated accordingly to 
be displayed on the LCD of the PDA, so that the user can conveniently 
determine an accurate heading. 

[00481 In addition, the present invention facilitates an implementation of a three- 

dimensional game through the information on the direction of rotation of the 
game machine in addition to the attitude of the game machine. Further, the 
present invention can be used as a data input device in connection with virtual 
reality. 

[0049] Preferred embodiments of the present invention have been disclosed 

herein and, although specific terms are employed, they are used and are to be 
interpreted in a generic and descriptive sense only and not for purpose of 
limitation. Accordingly, it will be understood by those of ordinary skill in the art 
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that various changes in form and details may be made without departing from 
the spirit and scope of the present invention as set forth in the following claims. 



